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I. INTRODUCTION 


A. REASON FOR ANALYSIS 

The control of flexible spacecraft structures has been a topic for research for 
several years. Every since Explorer I began it’s now famous tumble, dynamicists have 
been concerned with the effect flexible structures have on spacecraft attitude and control. 
In the early days of the space program, most satellites and vehicles consisted of rigid 
bodies with very small, flexible appendages. The effects of these appendages were 
considered mostly in terms of energy dissipation and in turn the effect on attitude 
stability. Current spacecraft have much higher power requirements than in the past, thus 
requiring larger solar arrays. Dish antennas with substantial support structures are being 
utilized. Lighter structural materials are being employed to save launch costs. Higher 
pointing accuracies are now required. All of these factors contribute to a wider control 
bandwidth and a lower structural frequency resulting in the possibility of control/structure 
interactions. These interactions must be known and controlled in order to meet the 
demands of the next generation of spacecraft. 

In order to determine the effect of flexibility on the control of spacecraft, 
experiments in the design and location of sensors and actuators as well as the control 
laws should be conducted. Conducting experiments in space is prohibitively expensive. 
Simulations on computers are very important and useful, but nonetheless cannot be 


proven accurate until actually implemented. Conducting experiments on the ground in 


a gravity-free environment is impossible. However, by proper design, two-dimensional 


experiments may be conducted in a frictionless environment. 


B. SCOPE OF THESIS 

This thesis covers the design of the Naval Postgraduate School’s Flexible 
Spacecraft Simulator or FSS. This experimental testbed was designed for the analysis, 
simulation and implementation of different control systems for flexible spacecraft. The 
FSS is a two-dimensional model of a spacecraft with a deployed, flexible, support 
Structure for an antenna. The initial basic design and choice of actuator/sensors was 
presented in Ward [Ref. 1]. This thesis details the integration of the actuator and 
sensors as well as the construction of the model. The equations of motion for the model 
are derived, as well as the state-space form for digital implementation. Finally, the first 


attempts at simulating the motion and control of the model are presented. 


Hi. EXPERIMENTAL SETUP 


The configuration of the experimental setup for the Flexible Spacecraft Simulator, 


(FSS), is shown in Figure 1. 
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Figure 1 Flexible Spacecraft Simulator 





A. SATELLITE MODEL 
The satellite model consists of an ’L’ shaped flexible appendage attached to a 
circular rigid body as shown in Figure 2. For this phase of the experiment, the reflector 


and feed horn are not used. The rigid body, denoted the "central body", is a 2.22 cm 





Figure 2: Satellite Model 


(7/8 inch) thick aluminum disk of 0.381 m (15 inch) radius. The central body is 
supported by three aluminum air pads and restricted from translational motion by an air 
bearing. The air pads are spaced equally about the circumference of the disk and are 
inset into the central body to minimize the height of the system above the table. The air 
bearing is connected to the central body by means of a thin, 0.127 mm (0.005 inch), 
flexible sheet of metal. This reduces the effect of any torque about the X or Y axis upon 
the air bearing, which has very little tilt stiffness. The top of the air bearing is 
connected to an I-beam with an adjustable bracket. The bracket and associated movable 
supports allow positioning of the model anywhere on the table’s surface. A cross sect- 


ional view of the air support system is shown in the following figures. 
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Figure 4 Body Air Pad Mounting Figure 5 Arm Air Pad Mounting 

The flexible appendage, denoted the "arm", is two 2.54 cm (1.0 inch) wide strips 
of aluminum, 1.58 mm (1/16 inch) thick, joined at the elbow by a bracket, which also 
supports an air pad. The end point is also a bracket for an air pad. The “upper arm" 
is connected to the central body by means of a clamped bracket. "Mass intensifiers", 
[Ref. 2], each with 0.467 kg (1.03 lb) of mass, are utilized to lower the fundamen- 


tal structural frequency of the arm to about 0.13 Hz. The mass intensifiers are connected 


to the arm at a single point, (see Figure 2). This increases the mass of the arm without 
significantly stiffening the arm. With this setup, large structures with low fundamental 
frequencies can be simulated using assemblies of much smaller physical dimensions. The 
upper arm has six mass intensifiers, and the "lower arm" has two at the end. One 0.467 
kg (1.03 lb) weight was added to the "elbow" bracket and two weights to the end bracket 
in order to prevent chatter in the air pads. This combination of weights yields the 
desired fundamental frequency. 6.35 mm (1/4 inch) air line tubing, 130 PSIG test, is 
connected to each air pad and to the air bearing from the air supply system. Appendix 
A contains information concerning the mass, dimensions and inertia properties of the 


satellite model. 


B. SENSORS 
Four types of sensors are employed on the satellite model: 
1. A rotary variable differential transformer, (RVDT), is connected to the rotor of 
the air bearing by a bellows-type device. The RVDT senses the angular position of 


the central body. 


2. An angular rate sensor, (ARS), is mounted on the central body and is used to 
determine the angular speed of the central body. 


3. An integral analog tachometer is used by the DC servo motor to report momentum 


wheel speed. 


4. Two accelerometers are connected to the endpoint of the lower arm and sense 
accelerations at the endpoint. 


The manufacturers specifications are given in Appendix B. 


C. ACTUATOR 

The actuator for the FSS, in this phase of the experiment, is a DC servo motor 
with a 10.7 kg (23.5 lb) steel disc connected to the shaft. The motor and disc assembly 
act as a momentum wheel for the satellite model. The entire assembly is housed in a 
separate aluminum structure which is then attached to the central body. Figure 6 shows 
the momentum wheel assembly with some of the panels removed for clarity. The DC 


servo motor is manufactured by PMI and the specifications are given in Appendix B. 
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Figure 6: Momentum Wheel Assembly 
The motor housing includes a bottom plate which is connected to the central body, a 
thermal plate to which the motor is mounted, and side panels which support the thermal 


plate. The size of the thermal plate is dictated by the heat output of the motor during 


worst case conditions. The steel wheel is covered by an aluminum safety housing to 


prevent injury during operation. 


D. CONTROLLER 

The control system consists of a VAXStation 3100 model 30, (networked to a 
mainframe VAX), the AC-100 controller, and the associated software for the AC-100. 
The VAXStation is a 2.8 MIPS (million instructions per second) workstation configured 
with eight Mbytes of main memory, a 19 inch color monitor, two 104 Mbyte winchester 
hard disks, and a mouse. The development software, which includes MATRIX,, 
AutoCode, Interactive Animation, RTMONIT Real-Time Monitor, a ’C’ Compiler and 
the Linker/Loader, is used to create the model of the FSS and executes on the 
VAXStation under the VMS operating system. The AC-100 Controller provides the 
real-time testbed execution environment. It consists of the following standard hardware 


components and their associated drivers: 


1. An 80386 based MULTIBUS II Application Processor. 

2. An 80387 Coprocessor. 

3. A Weitek 3167 Coprocessor. 

4. An 80186 based MULTIBUS II Input/Output Communications Processor. 
5. A/D, D/A and Digital Data Translation DT2402 I/O Board. 

6. Two INX-04 Encoder and D/A Servo Boards. 


7. An External Trigger Board for the first application processor. 


For details of the operating system see the AC-100 Users Guide, [Ref. 3]. The 
simplified electrical schematic for the sensors, actuator and controller is shown in 
Figure 7. The controller, servo-amplifier, power supply and transformer are housed in 


a 19 inch rack. 
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Figure 7 Simplified Electrical Schematic 


Hil. THEORETICAL ANALYSIS 


A. EQUATIONS OF MOTION 

In order to control the satellite oe efficiently, the dynamics of the system must 
be thoroughly understood. The first step is to determine the equations of motion of the 
model. The hybrid-coordinate system of Ref. 4 is utilized in this study. The 
hybrid-coordinate system separates the model into two distinct subsystems which may be 
classified as either a flexible appendage or a rigid body. The flexible appendage is 
assumed to be a linearly elastic structure for which "small" deformations may be 
anticipated such that elastic stresses remain proportional to deformations. The flexible 
body is further broken up into small rigid "subbodies". In this case, the flexible 
appendage is the "arm" and the rigid body is the "central body". Each subbody 
corresponds to a mass intensifier or an air pad bracket on the flexible arm. Lagrange’s 
equation together with the hybrid-coordinate system are used to derive the equations of 
motion of the model. Figure 8 depicts the coordinate system. 

Three coordinate axis are used in the derivation. A fixed, ("inertial"), coordinate 
system is located at the center of rotation of the system, (constrained by the airbearing 
to be the center of the rigid body). The origin of the second coordinate system is also 
located at the center of rotation, rotates with the body, and is the body coordinate 
system. The third coordinate system is located at the center of mass, (CM) of the system 


and is the CM coordinate system. The CM and body coordinate axis are parallel to one 
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Figure 8 Hybrid-Coordinate System 


another. 


Subscript A corresponds to the flexible appendage, C to the rigid body. 


Subscript W corresponds to the momentum wheel system and subscript S denotes a 


subbody on the arm. The other symbols used in the derivation are as follows: 


QO WS Ss = "U az ~~ NSIS 


VELOCITY VECTOR OF AN INFINITISIMAL MASS 


VELOCITY OF CM OF SYSTEM 
POSITION VECTOR 
TOTAL MASS 


MASS 
ANGULAR VELOCITY VECTOR OF SYSTEM 


POSITION VECTOR OF UNDEFORMED SUBBODY 
POSITION FROM UNDEFORMED TO DEFORMED SUBBODY 
ANGULAR POSITION OF MOMENTUM WHEEL 

ROTATION ABOUT Z (FIXED COORDINATE SYSTEM) 
INERTIA 

MODAL COORDINATE 

MODAL AMPLITUDE 


1] 


- KINETIC ENERGY OF SYSTEM 
- POTENTIAL ENERGY OF SYSTEM 
- LAGRANGIAN 


m - NUMBER OF MODES 

n - NUMBER OF SUBBODIES 
i - i* MODE 

j - j® SUBBODY 

w, - FREQUENCY OF i* MODE 
¢ - DAMPING 

T 

V 

L 


In order to form the Lagrangian, the potential and kinetic energy of the system 


must be known. The kinetic energy is found as follows: 


o1p ep 
T = —" dM +T, 


= 5 M,I6 <F(enyl? + : [ Oo¥o) aM + > [ G.V,)aM + Ty 
where V¢ is the velocity of a particle on body C with respect to the CM coordinates and 
V, is the velocity of a particle on body A with respect to the CM coordinates. The 
position of the center of mass from the fixed coordinate system is denoted r(cm), and Ty 
is the kinetic energy of the system due to the momentum wheel. V, will be due only to 


the rotation of the central body: 


Vi= 7 = Oxf, 2) 


The over-dot denotes differentiation of the vector with respect to time. 
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V, will have both rotational and translational terms. If the assumption is made 


that: 


[VV.dM = 


J=1 
V, may be expanded as follows: 
Vi= P, + uj, = OxP, + Uj + Oxi, 


Expanding the dot product of V; with itself for each subbody, yields: 


| 


ViVi = Vil@xP,) + Vy; + Vie(Oxi, 
jc (Ox i> (@ x i> + (@x i> u + (Ox j@ 
+ u(GxP,) + wk + u(x) + (xi) 


> 
Et 


IS 


(3) 


(4) 


(5) 


(6) 


Finally, expanding the kinetic energy term due to the momentum wheel: 
ip, = 5 Myl(SxFW)) (GxFW) + al ySy (7) 


where r(W) is the vector from the origin of the fixed coordinate system to the center of 
the momentum wheel. 

Utilizing the constraints of the experimental setup and the superscripts x, y and z 
to denote components of a vector along the CM coordinate axis, the vector equations are 


replaced by the following: 


& = Pk 
GxP, = (-¥P?)i + (¥P;)j 
Oxi, = (Sua) + (Pu; )j 
y,-V, = ¥|(P;) + (P})| + uu; - 2¥P? - 2¥u?) (8) 


+ 


uy? + 2EP; + 2¥u;) 
us[P°(2P; + u;)] 
+ u?[P°(2P? + u?)] 


Be 


Noting that the components of the deflection vector, u, may be written as below: 


uy 7 y 6,90), u) = ye $3,9,(0), (9) 


the kinetic energy of the system may now be written in terms of the modal coordinates 


and amplitudes, and the systems angular velocity: 


14 


_ lwp 2 = 2 : p 2 
Las ae [M,|r(cm)|* + [le dM + 2 MiIP,H 


l w2t—> 12 1 12 
—M _¥ —] 
5 9 W yl a 2 wow (10) 


2 (MUG + 2ROYAP; - OAR) + Ai 
+ Pig; + Oya,P)) + PO) a + ()'ai7} 


The first term in the brackets is the inertia of the system about the Z axis (fixed 


coordinate system), minus the terms due to the momentum wheel itself, or: 


Izz = M;|F(cm)|? + f \FcPdM + M,1P,/? (ay) 
jel 
The potential energy 1s now calculated using standard matrix notation: 
1 
V = — [u)" [KI [u) [u] = [][q] 
: (12) 
= 5 (al [oY HA 41 fa 


where /k] is the stiffness matrix. If /¢J 1s normalized such that the mass matrix is unity, 


then 


[o)" [A [6] =} @? (13) 


where the term on the right is the diagonal matrix of natural frequencies for each mode. 


This results in: 


15 


V = —[q]"| wo) {Iq 
2 7 (14) 


Now that the potential and kinetic energy of the system have been determined, the 
Lagrangian, L = T - V, may be formed. Lagrange’s equation is written: 
alan)" a °° " 
with each generalized coordinate represented by p,; and the generalized forces by Q,. The 
generalized coordinates for this system are ¥, Oy, and each of the q,;’s. The virtual 
work principle may be utilized to determine the Q,’s. Taking N to be the total number 


of generalized coordinates: 


N 
dw = 0°Q,-bp, = TS¥ - T80, 46 


i=1 


Cpe = aN} 0 Pe 


W 


where T is the torque applied by the motor. Lagrange’s equation for each of the 


generalized coordinates can now be written as follows: 


Ce ao! - 
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{|M,(20;Pi4, + (Oar + 26774, + (OYPai) + MylFOME]E 
. M, |d;P; / iP? |4, 


+ M,|2o;P; + 2; )°a, + 265P) + 2(64)°a,| Pq} = T 


LY + 


nom 
=] 


j=1 i 


(18) 


n 


y {M,|(oi)? + (3°14, - [M,(@)? + @)?) - oF]a, a, 
- M; loi; ue $5 te as M; ty a 7 iP? | iB = 0 
Equation (19) above is repeated for each of the m modes. Assuming that the body slew 
rate is small, the nonlinear terms will tend toward zero. Dropping the nonlinear terms 
and introducing a damping term for each mode yields the following linearized equations 
of motion: 

iF + SD =T = -1,6, 


i=] 


Eq; . 200.4; i (w,)"q, a DY = 0 


where: ie = 7, + M,|7F(W)|? (20) 


v= Sine 


E,= Daye + @M, 


j=l 


Again, the last equation is repeated for each of the m modes, resulting in m + 1 
equations to be solved in order to determine the motion of the model. The D, term is 


designated the flexible coupling term and &; is the modal mass term. If the modal 


i? 


coordinates, $,, are normalized such that the mass matrix is unity, then &; will also be 
unity. This fact is used to check the results of the finite element analysis of the arm. 
The damping term ¢ must be assumed or experimentally determined. 

In order to implement the equations on a digital computer, a state-space 


representation of the system of equations is constructed. The state-space format 1s: 


A]xX + [BJU (21) 


al 
Y = [C]X + [D]U 


where X is the vector of state variables, Y is the output vector, and U is the vector of 
inputs. The matrices A, B, C and D complete the description of the system of equations 


in state-space form. For the FSS, the state variables are chosen to be: 


X= ['¥ Greedy sec meted ee (22) 
The output vector Y, 1s defined by the sensors installed on the model: 
y=(¥, ¥], (23) 
The input vector U is the torque applied by the motor: 
U =T (24) 
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Rearranging the equations of motion to explicitly solve for the second derivative with 
respect to time of the state variables, in terms of the state variables and the input torque 


aA: 


J 
a 


» [26 0,4, “ D;(;)q)] 
i=] 
lz 7 ye (D,’ 


Zz 
-(w,)*q, a 200.4; 2 


2a: 
It 


m 


> [P26 0,4, zs CA) pi 


-~D i=l 
m 
if - > (Dy 


i=l 
Note that if a mgid body were assumed, all of the q;’s and q,;’s would be zero and Euler’s 


equation would result: 


(26) 


y [3 


ie 


The state-space representation can now be written as follows: 


. 0 0 0 Oo = 0 eo 0 Oo ale 
e o2 q 
4, 0 O 0 oO . 0 0 “i 0 )2 M0 : 
, 2 
qo 0 oO 0 0 =s0 0 0 [20> & ; 

3 
Im! _({1)/0 oO 0 0 . 0 0 0 0 .. wie 
P| Gree 4 
*| zjo fF, F, Fae Bee, 9H 1, = aie 
“al 0 -G, -D,F, -D,F, .. -D,\F, -J, -D,H, -D,H, .. -D,H,\|4, 


q 
; 0 -D,F, -G, -D,F, .. -D,F, -D,H, -J,  -D,H, .. -D,H,, q2 








0 -D,,F —D,,F, -D,F; es -G,, -D,,H, -D, 1, -D,,H, aa Fn qm 27) 


Im 
0 
0 
0 
0 
+ 1 0 (T) 
Iz)| 1 
-D, 
-D, 
=Dx 
here: 722 = 2 = pres 2 
where: I77 = Izz - ))(D,), F, = Do; 
2 702 " (28) 
G; = oly + DF;; H, = 2¢0,D, 


J, = 2Calz + DH, 
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The observation equation is wnitten below: 


q; 


9» 


y 
¥ 


100..0000... O}|%m 
000.0100... OF 


+ [0] (1) ae 











q 
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B. FINITE ELEMENT MODEL OF APPENDAGE 

In order to utilize the state-space equations written above, the mode shapes and 
associated frequencies must be determined. For simple geometries, the required modal 
coordinates and natural frequencies may be solved for by analytical means. TREE: 
for complex geometries such as the FSS, a finite element analysis is required. The 
interactive finite element program GIFTS was utilized to model the arm. 

The appendage was modeled using beam elements with the same cross-section as 
the model’s arm, and point masses at the location of the mass intensifiers. Point masses 
were also placed at the elbow and tip to simulate the air pad brackets, air pads and 
associated masses. The appendage was divided into 20 nodes, each corresponding to a 


subbody in the hybrid-coordinate system. All degrees of freedom were suppressed at 


yi 


node one, (the central body attachment point), resulting in a fixed-free analysis. The 
rotations about the X and Y axis were also suppressed for all the nodes, in order to more 
closely approximate the constraints imposed by the two dimensional model. The modal 
analysis program was run resulting in the desired modal coordinates, normalized for a 
unity mass matrix, and the associated natural frequencies. The first six mode shapes are 


shown below. 
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Figure 9 Mode Shape One 
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MODE 2-- 3.464E-01 CPS 
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Figure 10 Mode Shape Two 
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Figure 11 Mode Shape Three 73 
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Figure 12 Mode Shape Four 
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Figure 13 Mode Shape Five 
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Figure 14 Mode Shape Six 


The output of the GIFTS program is given in Appendix C. Also given is a Fortran 
program that inputs the GIFTS result and outputs the A and B matrices of the state-space 
system described previously, in a form required by MATRIX, for use in modeling the 
system. 

As a check on the GIFTS output, an experiment was conducted on the model to 
determine the fixed-free natural frequencies of the arm. The model was floated on the 
air pads and the central body restrained from rotation. The arm was deflected into the 
first mode shape and released. The accelerations at the endpoint were measured using 
the PCB accelerometer, (described in Appendix B), and a HP-3561A Dynamic Signal 


Analyzer. The accelerometer was mounted perpendicular to the lower arm. Table I 
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shows the results. Figure 15 and Figure 16 show the actual output of the analyzer. The 
first two frequencies agree very well with the GIFTS data. Any frequencies above mode 
two had too low of an amplitude to be measured accurately and could not be verified. 
Even initially deflecting the arm into these mode shapes resulted in very low amplitude 


oscillations, not measurable by the installed equipment. 


TABLE I Comparison of GIFTS Data with Experimental Results 


GIFTS 
_ one | 01 He 0.122 He 





0.346 Hz 11.3% 
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Figure 15 First Modal Frequency 
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Figure 16 Second Modal Frequency 
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IV. DYNAMIC SIMULATION 


A. MATHEMATICAL MODEL 

As a Step in understanding the FSS and in attempting to control it, a mathematical 
model was constructed. The mathematical model can also be used as an observer in the 
control system, since only two of the state variables may be fed back. In constructing 
this model, the number of modes, m, must be truncated to some reasonable number. 
Modal truncation is a matter of importance and demands some study. However, since 
there are no sensors or actuators on the arm that are to be used in the present control 
system, a simple algorithm was used. As a minimum, include those modes that are 
observed in the motion of the arm, but do not include so many modes that the resulting 
matrices will be computationally difficult and time consuming to solve. As a result, the 
first six modes were used in the simulation. In deflecting the arm and observing the 
resulting motion, the first two modes appeared to be prevalent, with very little high 
frequency motion. Six modes result in a 14 by 14 dynamics matrix which may be 
readily solved. The first six modes also cover a factor of 100 increase in the natural 
frequencies. 

The state-space system is generated by the Fortran program Form ,(Appendix C), 
assuming that structural damping of the aluminum beam is two per cent of critical. The 
system of matrices is implemented on the VAX workstation. In order to use the 


simulation to run the real time controller, the ’plant’ must be discretized. A 0.01 sec 
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sampling interval was chosen for the discretization, giving approximately ten samples per 
period of mode six, the highest frequency mode shape simulated. A one N-m torque of 
0.1 second duration was simulated to observe the effects of the flexible appendage. This 
impulse was also simulated on a rigid body with the same mass and inertia properties. 


The resulting position and rates are plotted in Figure 17. 





Figure 17 Rigid vs. Flexible Model 


These results clearly show the impact of flexibility on attitude control. The mgid body 
has a smooth transition to rotation about its center of mass whereas the flexible model 
begins to oscillate, damping out after several hundred seconds. The large variation in 
body rates for the flexible model is due to the springing action of the arm, as can be seen 


in Figure 18. 


2 


Beam Flexure 





Figure 18 Arm Motion Following Impulse 


In the figure above, the position of the arm with respect to the main body is plotted on 
the X and Y axis. The Z axis represents time in seconds. The arm’s position is 
presented every two seconds. This format will be used to show the motion of the arm 
during a maneuver. 

The next step is to determine the control laws for the flexible model. Each type 
of control will be subjected to a one N-m impulse, a five degree bias maneuver, and a 


30 degree counter-clockwise slew maneuver to determine viability. 


B. PROPORTIONAL-DERIVATIVE CONTROL 
Proportional-derivative (PD) control is obtained by simply feeding back the body 


position, W, and the body rate, W, through a gain block. Three control system 
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frequencies were chosen: w, = 0.05, 0.1 and 0.38 Hz. The first frequency was chosen 
to minimize control-structural interactions. The second and third were chosen to analyze 
the effect of a control system operating at the first and second mode’s frequencies. 
Damping, ¢, was chosen as 0.707 of critical. One simulation was run with ¢ at critical 


damping. The gains, K and 7 in the control law 


T, = -K(c6 + 8) (30) 


are calculated by the equations, (see Ref. 5): 


ao WV 
WN 
i 
S 


ea (31) 
loz 


The values for K and 7 are given in the table below. 


TABLE II 


| pois | os | 00 | oe | 635 
| oz | oto | or07 | 31 | 2.25 
sf | o.707 | 564s | 059 







The impulse response, bias and slew maneuvers for PD1A are shown in the 
following graphs, (Figure 19, Figure 20 and Figure 21). In the graphs, the momentum 
wheel speed in RPM, wheel torque in N-m, body position in degrees, and body rate in 


degrees per second, (dps), are plotted versus time in seconds. PD1B shows little 
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difference from PD1A except in the slew maneuver. PD1B takes about twice as long to 
reach 30 degrees as PDIA, with very little overshoot, as can be seen in Figure 22. 
Figure 23 shows the modal amplitudes for modes one and two, (ql and q2), for the 0.05 
Hz system. Modes three through six can just be seen between zero and ten seconds into 
the slew maneuver. Figure 24 shows the motion of the arm during the first 25 seconds 
of the slew, while Figure 25 is a "top" view of the motion which shows the extent of 
movement of the arm. Figure 24 and Figure 25 is obtained by multiplying the modal 
amplitudes as a function of time by the modal coordinates for each node, summing over 
all the modes and adding this value to the position of the undeformed node with respect 


to the center of rotation. 
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Figure 19 Impulse Response 
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Slew Maneuver 


Figure 22 





Figure 23 Slew Maneuver, PD1IA 
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Figure 24 Slew Maneuver, 
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PD2 show a quicker time response to the maneuvers as expected, (see Appendix 
E). However, as can be seen in Figure 26, the amplitude of mode one has increased 
about 50% and mode two has increased 100% during the slew maneuver. Modes three 


and four are also beginning to show in this figure. 


25 


TIME sec 


Modal Amplitudes 





Figure 26 Slew Maneuver, PD2 


PD3 has an even quicker time response and very acceptable control of the main body, 
(Appendix E). Figure 27 presents the 30 degree slew for PD3. The main body reaches 


the 30 degree position with no overshoot in about two seconds. The 20 N-m wheel 
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torque required is within the capabilities of the motor. Figure 28 shows that the modal 
amplitudes, (modes one and two), have increased by a factor of three over the amplitudes 
in PD1, resulting in the highly undesirable whip-like motion of the arm shown in 
Figure 29 and Figure 30. Note that the torque on the body from the oscillations of the 


arm is controllable by the momentum wheel, even at these amplitudes. 
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Figure 27 Slew Maneuver, PD3 
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Figure 28 Slew Maneuver, PD3 
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Figure 29 Slew Maneuver, PD3 
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Figure 30 Slew Maneuver, PD3 


C. LINEAR-QUADRATIC-GAUSSIAN COMPENSATOR 

The second type of control system studied was the linear-quadratic-gaussian or 
LQG compensator. The LQG compensator is formed from a linear regulator and a 
Kalman filter estimator. The regulator design assumes full-state feedback, and a 
controllable system. The controllability grammian, [Ref. 6], for the system of 
matrices is computed using MATRIX, and is found to be of full rank, ensuring controlla- 
bility, assuming the system to be dynamically stable and time-invariant. The optimal 


gains are calculated by minimizing the cost function: 
cost = HM Rae + u'R,,u ) de (32) 
0 


where R,, 1s the state weighting matrix and R,,, is the input weighting matrix. The gains 


are determined by first solving for M in the algebraic Ricatti equation, [Ref. 6]: 


O = MA + A’M - MBR,B’M + R, (33) 
where A and B are the system dynamic and control input matrices respectively. The 


optimum gain is now given by: 


G = R.B'M (34) 
These functions are computed by the command REGULATOR, in the MATRIX, Control 
Design Module, [Ref. 7]. 
The Kalman filter design is performed in much the same way, utilizing the duality 


theorem for estimators and regulators. However, instead of state and input weighting 
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matrices, R,, and R,,, the state and observation noise intensities, Q,, and Q,,, must be 


determined. For a linear time-invariant system, 


x = Ax + Bu+ Fw (35) 
y=Cx + Durty 


where w is the input disturbance, F is the input disturbance matrix, and v is the 
measurement noise, the noise intensity matrices are defined, [Ref.7]: 
/ = = 
sapiens = Q,, 5(t t) (36) 
E(Fw(t)v'(t)) = QO. 6(¢ - t) 
where E is the expectation operator and 6 is the delta function. The noises, w and y, are 


assumed to be white with zero mean. For the FSS, the assumption is made that the only 


disturbance is a random torque of 0.01 N-m amplitude and thus: 


Q.. = B(0.01)B’ (37) 
Q,, 1s assumed to be a two by two diagonal matrix with the first term on the diagonal 
corresponding to the noise from the RVDT and the second term corresponding to the 
noise from the angular rate sensor. The best available estimate of noise is used until 
such time that the experimental value can be used. Thus: 


2E-6 QO 
O 6E-6 


Q, a (38) 








The Ricatti equation is solved again and the gains computed as before, however the gain 


matrix will now be a 14 by two since there will be two inputs into the estimator, (the two 
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Outputs of the system). The estimator gains are computed in MATRIX, with the 
command ESTIMATOR in the Control Design Module. 

The compensator 1s now synthesized using the A, B, C and D matrices of the 
system and the regulator and estimator gains, Kr and Ke respectively. The form of the 


compensator is as follows: 


ee BE (39) 


Kr | O 
where SC is the compensator system matrix. The LQGCOMP command in the Control 
Design Module of MATRIX, accomplishes this formation. The block diagram for the 
control system, as well as the points at which inputs and outputs are taken, is given in 


Figure 31. 





Figure 31 Block Diagram of Control System 
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All that remains is to determine R,, and R,,. R,, 1s a 14 by 14 matrix and is 
assumed to be diagonal, with each term on the diagonal corresponding to a state. R,, 
is simply a scaler, since there is only one input. Positioning the main body is the 
primary concern of this thesis and therefore the first term on the diagonal, which 
corresponds to body position YW, is set to one, and all others are set to zero. R,, is 
assigned 0.001 in order to prevent exceeding the design limits of the motor. The systems 
response to the impulse disturbance and bias maneuvers are given in Appendix E. These 
figures show an acceptable response for the body with a 0.23 degree error during the 
impulse and three seconds required for the bias maneuver. The arm shows little 
deflection during the impulse and acceptable oscillations during the bias maneuver. 
Figure 32 shows the response to a 30 degree slew. The body reaches the desired 
position in about three seconds and the motor torque is well within limits. Examination 
of Figure 33 reveals that modes one and two are highly excited during the slew, and 
modes three and four moderately excited. The resulting extreme motion of the 
appendage is shown in Figure 34 and Figure 35 . This motion would more than likely 


result in permanent deformation of the beam. 
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Figure 
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Figure 33 Slew Maneuver, Cl 
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Figure 35 Slew Maneuver 


Figure 34 Slew Maneuver, Cl 
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A second means of control is required for large angle maneuvers. The modal 
amplitude graph indicates that by controlling ql and q2, acceptable results could be 
achieved. An attempt to do this is made by varying the weights on the ¥, ¥, ql, ql, 
q2, and q2, as well as the weight on the torque input. TABLE III indicates values used 


for the significant results. The figures for C2 through C7 are given in Appendix E. 


TABLE II Weighting Factors 


po Po 
1000 
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C8 shows the best results for the optimum controller for the slew maneuver. The 


following four figures show the response of the central body and the flexible arm. The 


slew rate is slow, but this is required in order to prevent exciting the first and second 


modes of the arm. 
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Figure 36 Slew Maneuver, C8 
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Figure 37 Slew Maneuver, C8 
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Figure 38 Slew Maneuver, C8 Figure 39 Slew Maneuver, C8 
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As acomparison of the PD controller and LQG compensator, an on-orbit mode was 
designed to maintain 0.05 degree pointing accuracy of the central body. For the PD 
controller, the gains, K and 7 were computed using the equations found on page 139 of 
Ref. 5, and assuming that the model could be treated as rigid. The inertia of the system 
about the Z axis, (fixed), was used in the calculations. The required gains are: K = 
179.3, 7 = 84.3. For the LQG compensator, R,, was the same as used for Cl, but R,, 
was set at 10° in order to maintain 0.05 degree accuracy. R,,, was arrived at by trial and 
error. The results are presented in Figure 40 through Figure 43. Both controllers 


control well in the on-orbit mode with only a millimeter movement in the endpoint. 
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Figure 41 On-Orbit Mode, LQG Compensator 


Figure 40 On-Orbit Mode, PD Control 
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Figure 43 On-Orbit Mode, LQG Compensator 
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V. CONCLUSIONS 


The Flexible Spacecraft Simulator, (FSS), is fully assembled and should become 
operational within the next few weeks. The initial operational configuration has sensors 
and an actuator on the central body. A picture of the present setup is provided in 
Appendix A. With this Phase I setup, actual experiments into the effect of flexible 
spacecraft structures on attitude dynamics and control can be carried out. 

Both the PD control and the LQG compensator show that on-orbit control of the 
central body is readily achievable. Control of the antenna endpoint is not as good, with 
the maximum deflection reaching about one mm for a one N-m impulse disturbance. 
Slewing the central body at a fairly high rate of speed is possible, but at the expense of 
severe oscillations of the arm, and at some point, damage to the arm itself. The 
oscillations imposed by the rapid slew do not damp out quickly, but the torque imposed 
on the central body is small enough that the actuator can still maintain the position of the 
body. Results show that the LQG compensator is better for slewing the arm, but in 
order to use this type of control, two compensators will be required. One compensator 
will be set up for the on-orbit mode, and one for slewing the satellite model. 
Satisfactory control can be achieved, but the maximum slew rate will be about one 


deg/sec. 


51 


A. RECOMMENDATIONS FOR FURTHER STUDY 

Experimental verification of the mode shapes and frequencies as well as the 
damping coefficient should be accomplished as soon as the instrumentation is available. 
Also, further work is required in optimizing the control design for the slew maneuver 
using only the single actuator. Control of the central body is readily achievable using 
both PD and LQG control, but at the expense of moderate to severe oscillations of the 
arm. Attempts to control the arm using the LQG compensator and weighting the time 
rate of change of the first two mode shapes result in minimizing the amplitude of the 
oscillations. However, control of the position of the central body is then lost. Weighting 
both the arm and the central body results in a slow maneuver of about one deg/sec and 
low amplitude oscillations of the arm. The magnitude of the time rate of change of the 
acceleration, otherwise known as "jerk", and more importantly, the length of time that 
the jerk is applied appear to have the most effect on the amplitude of the oscillations. 
By programming the body rate during the maneuver such that this effect is minimized, 
better control of the arm and a more rapid slew might be achieved. 

The FSS can be easily expanded to using piezoelectric sensors and actuators on the 
flexible arm. In follow on phases, thrusters may be added to the central body, as well 
as liquid tanks. Endpoint sensing will be added and control of the arm’s endpoint 
attempted. Deployment of space structures, such as antennas and solar arrays, can be 
tested. By adding a motor to the elbow and endpoint, space robotics experiments may 
be attempted. The FSS will be an extremely useful research and teaching tool in the 


challenging area of attitude dynamics and control. [Ref. 8] 
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The design of the experimental setup to simulate spacecraft structural/control 
interactions has been challenging. The current design simulates the classical control 
method where sensors and actuators are located on the central body. However, it can 
be easily extended to simulate control configurations where the sensors and actuators are 
distributed throughout the model. It is a versatile testbed for the investigation of 
techniques in dynamics and control of flexible spacecraft. More importantly, it allows 


experimental verification of analytical results prior to implementation on flight spacecraft. 
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APPENDIX A 





Figure 44 Flexible Spacecraft Simulator 
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Figure 45 Key to Inertia Spreadsheet 
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Figure 46 Inertia of System 
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Figure 47 Inertia of System, cont. 
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APPENDIX B 


A. ROTARY VARIABLE DIFFERENTIAL TRANSFORMER 


1. Manufacturer - Schaevitz Engineering 
2. Model - R30D 
3. Scale Factor - 0.126 VDC/degree 


4. Linearity - 0.16% 


B. ANGULAR RATE SENSOR 


1. Manufacturer - Watson Industries, Inc 
2. Model - ARS-C121-1A 
3. Sensitivity - 30 deg/sec full scale 


4. Frequency Response - DC to 50 Hz 


C. ACCELEROMETER 


1. Manufacturer - PCB Piezotronics, Inc 
2. Model - 302A02 
3. Resolution - 0.01 g 


4. Frequency Range (+ 5%) - 0.05 to 5000 Hz 
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Gy. 


el 


I . 


iS. 


14. 


Ne 


16. 


DC SERVO MOTOR 


. Manufacturer - PMI Motion Technologies 


Model - JRI6M4CH/F9T 

Horsepower - 1.4 HP 

Peak Torque - 5307.2 oz-in 

Peak Acceleration without Load - 63.2 KRAD/SEC’ 
Cogging Torque - 0 


Terminal Voltage - 128.7 VDC 


. Current - 9.55 amp 


. Power Output - 1049.5 Watts 


Torque Constant - 52.77 oz-in/amp 

Mechanical Time Constant, no load - 3.15 msec 
Electrical Time Constant - < 0.14 msec 

Speed Regulation - 0.36 RPM/oz-in 

Motor Diameter - 7.38 in 

Motor Length - 4.50 in 


Motor Weight - 17.50 Ib 
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A. GIFTS OUTPUT 


JOB:arm5 9=-MAY-91 15:39:128 
FREQUENCIES 
MODE FREQ EIGV 
1 1.21602E-01 5.83767D-01 
Z 3.46436E-01 4.73812D+00 
3 2.65877E+00 2.79075D+02 
4 3.55180E+00 4.98031D+02 
5 6.12919E+00 1.48308D+03 
6 1.66874E+01 1.09935D+04 
JOB: arm5 9-MAY-91 MODE 1 -- 1.216E-01 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0.000E+00 0O.0O00E+00 O0O.000E+00 0O.O0O0E+00 
2 1.390E-08 1.917E-03 1.114E-36 0.000E+00 
3 1.529E-07 2.028E-0O1 1.499E-35 0.000E+00 
4 1.824E-07 2.801E-01 2.078E-35 0.000E+00 
5 9.730E-02 2.801E-0O1 2.726E-35 0O.0O0O0E+00 
6 §5.192E-0O1 2.801E-01 3.567E-35 0.000E+00 
7 6.219E-01 2.801E-01 3.804E-35 0.000E+00 
8 3.127E-08 9.552E-03 2.934E-36 0.000E+00 
9 4.865E-08 2.274E-02 4.733E-36 0.000E+00 
10 6.602E-08 4.120E-02 6.498E-36 0.0O00E+00 
11 8.339E-08 6.465E-02 8.218E-36 0.000E+00 
12 1.008E-0O7 9.281E-02 9.936E-36 0.000E+00 
13 1.181E-07 1.254E-01 1.165E-35 0.0O00E+00 
14 1.355E-07 1.622E-01 1.337E-35 0O.0O00E+00 
15 1.524E-0O1 2.801E-01 2.851E-35 0.000E+00 
16 2.098E-O1 2.801E-01 2.975E-35 0.0O00E+00 
17 2.692E-01 2.801E-01 3.099E-35 0.0O00E+00 
18 3.301E-Ol1l 2.801E-01 3.223E-35 0.000E+00 
19 3.923E-0O1 2.801E-01 3.346E-35 0.0O00E+00 
20 4.555E-01 2.801E-01 3.469E-35 0.0O00E+00 
JOB: arm5S 9-MAY-91 MODE 2 -- 3.464E-0O1 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0O.O000E+00 0O.000E+00 O.O00E+00 0O.O00E+00 
2 6.883E-08 -6.424E-03 -3.061E-28 0.000E+00 
3 7.571E-07 -3.852E-01 -4.119E-27 0.000E+00 
4 9.034E-07 -4.343E-01 -5.711E-27 0.000E+00 
5 -3.969E-03 -4.343E-01 -7.490E-27 0.000E+00 
6 3.009E-0O1 -4.343E-01 -9.801E-27 0.000E+00 
7 4.022E-01 -4.343E-01 -1.045E-26 0.0O00E+00 
8 1.549E-07 -3.043E-02 -8.062E-28 0.0O00E+00 
9 2.409E-07 -6.859E-02 -1.301E-27 0.000E+00 
10 3.269E-07 -1.171E-01 -1.786E-27 0.0O00E+00 
11 4.130E-07 -1.721E-01 -2.258E-27 0.0O00E+00 
12 4.990E-07 -2.301E-01 -2.730E-27 0.0O00E+00 
13 5.851E-07 -2.874E-01 -3.202E-27 0.0O00E+00 
14 6.711E-07 -3.402E-01 -3.674E-27 0.0O00E+00 


APPENDIX C 
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15:39:19 


RY 
0.000E+00 
0.000E+00 
0.000E+00 
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0.000E+00 
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0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
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RZ 
0.000E+00 
7.501E-02 
6. 6O93E=01 
7. 612E-02 
8.486E-01 
1.008E+00 
1.012E+00 
1.647E-01 
2.-499E-01 
3.307E-C2 
4.071E-01 
4.791E-01 
5.468E-01 
Ger OLE-—OF 
8.869E-01 
9.201E-01 
9.479E-01 
9.706E-01 
9.880E-01 
1 .Q000E+00 


PAGE 


RZ 
0.Q000E+00 
-2.464E-01 
-6.276E-01 
—2.597E-08 
1.782E-6F 
9.829E-O01 
1.005E+00 
-4.996E-01 
-6.922E-01 
—SecolE-Gu 
=e 70h Om 
-9.168E-01 
-8.767E-01 
-7.794E-0O1 


i 


1 


0.000E+00 
0.O000E+00 
0.Q000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
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RY 
0.000E+00 
0.O000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
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RY 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
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RY 


3.709E-01 
5.376E-01 
6.782E-01 
go256-O1 
&.815E-01 
9.442E-01 
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RZ 
0.000E+00 
2.014E+00 

-4.275E+00 
-4.782E+00 
-3.628E+00 
5 .428E+00 
6.403E+00 
3.306E+00 
3.367E+00 
2.517E+00 
1.267E+00 
-7.512E-02 
-1.500E+00 
-2.997E+00 
-2.753E+00 
-1.705E+00 
-4.958E-01 
8.632E-01 
2.359E+00 
3.979E+00 


PAGE 


RZ 
0.000E+00 
-2.330E+00 
2.818E+00 
2.391E-01 
-3.010E+00 
6.757E+00 
8.730E+00 
-3.498E+00 
-2.995E+00 
-1.436E+00 
2.636E-01 
1.576E+00 
2.487E+00 
2.983E+00 
-3.639E+00 
-3.532E+00 
-2.702E+00 
-1.167E+00 
1.050E+00 
3.925E+00 
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15 1.360E-02 -4.343E-01 -7.833E-27 0.0O00E+00 
16 4.258E-02 -4.343E-01 -8.174E-27 0.000E+00 
17 8.132E-02 -4.343E-01 -8.515E-27 0.000E+00 
18 1.282E-01 -4.343E-01 -8.854E-27 0.000E+00 
19 1.815E-01 -4.343E-01 -9.193E-27 0.000E+00 
20 2.396E-01 -4.343E-01 -9.531E-27 0.000E+00 
JOB: arm5 9-MAY-91 MODE 3 -- 2.659E+00 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0.000E+00 O.0O00E+00 O.000E+00 O0O.0O00E+00 
2 -4.969E-07 5.494E-02 -4.018E-18 0.000E+00 
3 -5.466E-06 3.727E-01 -5.372E-17 0.000E+00 
4 -6.521E-06 -1.385E-01 -7.411E-17 0.000E+00 
5 -5.142E-01 -1.385E-01 -9.646E-17 0.O00E+00 
6 -3.166E-01 -1.385E-01 -1.255E-16 0.000E+00 
7 3.009E-01 -1.385E-01 -1.336E-16 0.000E+00 
8 -1.118E-06 2.309E-01 -1.058E-17 0.000E+00 
9 -1.739E-06 4.487E-01 -1.705E-17 0O.000E+00 
10 -2.360E-06 6.392E-01 -2.339E-17 0.000E+00 
11 -2.981E-06 7.599E-01 -2.954E-17 0.0O00E+00 
12 -3.602E-06 7.982E-01 -3.568E-17 0.000E+00 
13 -4.223E-06 7.486E-01 -4.183E-17 0.000E+00 
14 -4.84S5E-06 6.062E-01 -4.796E-17 0.0O00E+00 
15 -7.177E-01 -1.385E-01 -1.008E-16 0.000E+00 
16 -8.601E-01 -1.385E-01 -1.050E-16 0.000E+00 
17 -9.308E-01 -1.385E-01 -1.093E-16 0.000E+00 
18 -9.199E-01 -1.385E-01 -1.136E-16 0.000E+00 
19 -8.183E-01 -1.385E-01 -1.178E-16 0.0O00E+00 
20 -6.177E-01 -1.385E-01 -1.221E-16 0.0O00E+00 
JOB: arm5 9-MAY-91 MODE 4 -- 3.552E+00 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0.000E+00 0O.000E+00 0O.Q00E+00 0O.000E+00 
2 -1.978E-06 -6.461E-02 -7.421E-13 0.000E+00 
3 -2.176E-05 -9.639E-02 -9.922E-12 0.000E+00 
4 -2.596E-05 9.628E-02 -1.369E-11 0.000E+00 
5 -1.943E-01 9.628E-02 -1.782E-11 0.000E+00 
6 -4.788E-Ol 9.630E-02 -2.318E-11 0.000E+00 
7 3.414E-0Ol1 9.630E-02 -2.468E-11 0.000E+00 
8 -4.450E-06 -2.597E-01 -1.954E-12 0.000E+00 
9 -6.922E-06 -4.736E-01 -3.150E-12 0.000E+00 
10 -9.395E-06 -6.177E-0O1 -4.320E-12 0.000E+00 
11 -1.187E-05 -6.529E-01 -5.456E-12 0.000E+00 
12 -1.434E-05 -5.924E-01 -6.591E-12 0.0O00E+00 
13 -1.681E-05 -4.612E-01 -7.725E-12 0.000E+00 
14 -1.928E-05 -2.853E-01 -8.859E-12 0.000E+00 
15 -4.093E-Ol1l 9.629E-02 -1.862E-11 0.000E+00 
16 -6.409E-01 9.629E-02 -1.941E-11 0.000E+00 
17 -8.426E-01 9.629E-02 -2.020E-11 0.000E+00 
18 -9.691E-0O1l 9.629E-02 -2.099E-11 0.000E+00 
19 -9.764E-01 9.630E-02 -2.177E-11 0.000E+00 
20 -8.219E-0O1 9.630E-02 -2.256E-11 0.000E+00 
JOB: arm5 9-MAY-91 MODE 5 -- 6.129E+00 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0.000E+00 0O.O00E+00 O0O.O000E+00 O0O.000E+00 0O.O000E+00 0.000E+00 
2 -1.587E-06 1.130E-01 3.628E-16 0.0O00E+00 
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0.000E+00 


3.885E+00 


1 


i 
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3 -1.746E-05 -6.445E-01 4.931E-15 0.000E+00 
4 -2.083E-05 1.459E-O1 6.886E-15 0.0O00E+00 
5S 4.542E-01 1.459E-01 9.133E-15 0.0O00E+00 
6 -1.567E-0O1 1.460E-01 1.205E-14 0.000E+00 
7 7.650E-02 1.460E-01 1.288E-14 0.000E+00 
8 —-3.571E-06 3.975E-O1 9. 561E-16 O[OGUETOU 
9 -5.555E-06 5.800E-01 1.544E-15 0.000E+00 
10 -7.539E-06 4.984E-0O1 2.123E-15 0.0O00E+00 
11 -9.523E-06 1.609E-Ol1l 2.690E-15 0O.0O00E+00 
12 -1.151E-05 -2.880E-01 3.257E-15 0.000E+00 
13 -1.349E-05 -6.774E-Ol1 3.824E-15 0.0O00E+00 
14 -1.547E-05 -8.373E-0Ol1 4.390E-15 0.000E+00 
15 4.635E-01 1.459E-0O1 9.565E-15 0.000E+00 
16 3.670E-0O1 1.460E-01 9.996E-15 0.000E+00 
17 2.080E-0O1 1.460E-O1 1.043E-14 0.000E+00 
18 3.123E-02 1.460E-01 1.086E-14 0.000E+00 
19 -1.174E-O1 1.460E-01 1.128E-14 0.000E+00 
20 -1.919E-O1 1.460E-01 1.171E-14 0.0O00E+00 
JOB: arm5 9-MAY-91 MODE 6 -- 1.669E+01 CPS 
DISPLACEMENT INFORMATION 
POINT U V W RX 
1 0.000E+00 O.O00E+00 O.OO0E+00 0O.0O00E+00 
2 -2.502E-06 4.201E-01 -1.665E-10 0.000E+00 
3 -2.750E-05 3.589E-01 -2.232E-09 0O.O00E+00 
4 -3.280E-05 -2.598E-02 -3.084E-09 0.Q00E+00 
5 -6.684E-O0O1 -2.601E-02 -4.025E-09 0.O00E+00 
6 1.220E-01 -2.611E-02 -5.246E-09 0.0O00E+00 
7 -2.433E-02 -2.613E-02 -5S.587E-09 JO2O000E=O0 
8 -5.630E-06 9.551E-01 -4.385E-10 0.000E+00 
9 -8.757E-06 3.730E-01 -7.071E-10 0.0O00E+00 
10 -1.188E-05 -7.914E-01 -9.703E-10 0.000E+00 
11 -1.501E-05 -1.353E+00 -1.226E-09 0.000E+00 
12 -1.813E-05 -1.231E+00 -1.481E-09 0.000E+00 
13 -2.126E-05 -6.937E-01 -1.737E-09 0.GO0OE+OO 
14 -2.438E-05 -4.728E-02 -1:992E-09 0.000E+00 
15 -8.606E-01 -2.603E-02 -4.206E-09 0.O00E+00 
16 -8.995E-0O1 -2.604E-02 -4.387E-09 0.0O00E+00 
17 -7.887E-O1 -2.606E-02 -4.566E-09 0.0O00E+00 
18 -5.617E-01 -2.607E-02 -4.746E-09 0.000E+00 
19 -2.786E-01 -2.609E-02 -4.925E-09 jO7000E+00 
20 -1.872E-02 -2.610E-02 -5.103E-09 0.QO00E+00 
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FORTRAN PROGRAM FORM 


PROGRAM FORM 


AUTHOR: R. J. WATKINS 


DATE: MAY 18, 1991 


0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
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RY 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.000E+00 
0.O000E+00 
0.000E+00 
0.000E+00 
0.000E+00 


5.642E+00 
6.691E+00 
1.199E+00 
1.417E+00 
2.733E+00 
4.293E+00 
1.004E+00 
-3.540E+00 
-6.641E+00 
-7.049E+00 
-4.767E+00 
1.696E-01 
-7.967E-01 
-2.128E+00 
-2.764E+00 
-2.683E+00 
-1.877E+00 
-3.489E-01 


PAGE 


RZ 
0.000E+00 
1.237E+01 
2.310E+00 

-6.379E+00 
-4.134E+00 
6.290E-01 
-2.474E+00 
5.754E-01 
-1.690E+01 
-1.545E+01 
-2.824E+00 
5 .951E+00 
1.017E+01 
9.311E+00 
-1.850E+00 
6.154E-01 
2.786E+00 
4.202E+00 
4.500E+00 
3.449E+00 


THIS PROGRAM READS IN DATA GIVEN BY GIFTS OUTPUT AND 
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1 


C PUTS IT INTO A FORMAT FOR STATE-SPACE MODELING 


DOUBLE PRECISION A(16,16), B(16), AI, BI 

REAL OMEGA(6),U(6,20), V(6,20),PSX(20), PSY(20),MS(20),IZZO1 

1,DS(6), ES(6), FS(6), GS(6), IW, IZZO2,HS(6),JS(6) 

OPEN (UNIT=10, FILE=’RESXDAT.LPT’, STATUS=’OLD’) 

OPEN (UNIT=11, FILE=’PS.DAT’ ,SSTATUS=’OLD’) 

OPEN (UNIT=12, FILE=’MS.DAT’ ,STATUS=’OLD’) 

OPEN (UNIT=13, FILE=’CHECK.DAT’  status=’new’) 

OPEN (UNIT=14, FILE=’ADMP’  status=’new’,CARRIAGECONTROL =’ LIST’) 
OPEN (UNIT=15, FILE=’BDMP’ ,status=’new’, CARRIAGECONTROL =’ LIST’) 


READ IN OUTPUT FROM PR_OUT BATCH FILE 


A Ore 


READ(10,5) 
5 FORMAT (///) 
DO 6 I=1,6 
READ(10,7) OMEGA(I) 
6 CONTINUE 
7 FORMAT (10X,E11.5) 
DO 12 I=1,6 
READ(10,5) 
DO 15 J=1,20 
READ(10,13) U(,J), VJ) 
15 CONTINUE 
12 CONTINUE 
13. FORMAT(7X,E10.3,1X,E10.3) 


READ IN MS AND PS DATA FILES 

PS IS POSITION OF EACH NODE (SUBBODY) IN METERS 

AND MS IS THE MASS OF EACH SUBBODY IN KG. NOTE 1: FIRST 
ENTRY IN MS.DAT IS THE INERTIA TERM FOR THE SYSTEM (IZZO1) 
NOTE 2: MASS AND POSITION OF EACH NODE MUST BE IN SAME 
SEQUENCE AS OUTPUT IN PR_OUT FILE!! 


Oa Oo) @ a er@ 


DO 20 I=1,20 
READ (11,*) PSX(1), PSY(1) 
20 CONTINUE 
READ (12,*) IZZO1 
DO 30 I=1,20 
READ (12,*) MS(1) 
30 CONTINUE 
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FORM THE TERMS FOR THE A AND B MATRIX. ALSO CALCULATE 
CHECK MATRIX ES: ALL ENTRIES SHOULD BE APPROX 1 IF 
DATA INPUT CORRECTLY. OUTPUT IS IN CHECK.DAT (ASCII) 
INPUT DAMPING FOR ARM (ZETA) NOTE: COULD BE CHANGED 
TO VECTOR IF NECESSARY 


Or@UG @-@5e @ 


ZETA =0.02 
IZZ02=IZZO1 
DO 35 I=1,6 
DS(1) =0.0 
ES(I) =0.0 
DO 32 J=1,20 
DS() =DS(1) +(V(I,J)*PSX(J)-U(,J)*PSY(J))*MS(J) 
ES(I) =ES() + (UC, J)**2 + VJ) **2)*MS() 
32. CONTINUE 
WRITE(13,*) ES(1) 
IZZO2 =IZZO2-DS(1)**2 
35 CONTINUE 
DO 38 I=1,6 
FS(1) =DS(1)*OMEGA (1)**2 
GS(1) =(OMEGA(I)**2)*IZZO2+DS(1)*FS(1) 
HS(1) =2.0*OMEGA(I)*ZETA*DS(1) 
JS(1) =2.0*ZETA*OMEGA(I)*IZZO02+ DS(1)*HS(1) 
38 CONTINUE 
GC 
C FORM A AND B MATRIX 
G 
DO 45 I=1,14 
DO 42 J=1,14 
A(1,J)=0.0 
42 CONTINUE 
45 CONTINUE 
DO 50 I=1,7 
A(I,I+7)=1.0 
50 CONTINUE 
DO 57 I=2,7 
A(8,]) =FS(1-1)/IZZO2 
57 CONTINUE 
DO 65 I=9,14 
DO 60 J=2,7 
A(1,J) =-DS(-8)*FS(J-1)/IZZO2 
60 CONTINUE 
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C 
C 
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ae 


DO 63 J=9,14 
A(1,J) =-DS(1-8)*HS(J-8)/IZZO2 
63 CONTINUE 
A(1,1) =-JS(I-8)/IZZ0O2 
A(8,1) =HS(I-8)/IZZO2 
A(I,I-7)=-GS(I-8)/IZZ02 
65 CONTINUE 


FORM CONTROL INPUT MATRIX B 


DO 70 I=1,7 
B(1) =0.0 
70 CONTINUE 
B(8) =1.0/IZZO2 
DO 75 I=9,14 
B(1) =-DS(I-8)/IZZO2 
75 CONTINUE 


WRITE MATRIX TO FILES. USE MATRIXX SUBROUTINE MATSAV TO 


CONVERT DATA INTO READABLE FORM FOR MATRIXX. OUTPUT 
IS IN ADMP AND BDMP. 


CALL MATSAV(14,’ASYS’,16,14,14,0,A,AI,’(1P2E24.15)’) 
CALL MATSAV(15,’BSYS’,16,14,1,0,B,BI,’(1P2E24.15)’) 
END OF PROGRAM 


STOP 
END 
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APPENDIX D 


The following table is reprinted for convenience: 


TABLE IV Weighting Factors 
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